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Abstract 

A  Small  AUV  Navigation  System  (SANS)  is  being  developed  at  the  Naval  Postgraduate 
School.  The  SANS  is  an  integrated  GPS/INS  navigation  system  composed  of  low-cost 
and  small-size  components.  It  is  designed  to  demonstrate  the  feasibility  of  using  a  low- 
cost  strap-down  Inertial  Measurement  Unit  (IMU)  to  navigate  between  intermittent  GPS 
fixes.  The  present  hardware  consists  of  a  GPS/DGPS  receiver,  IMU,  compass,  water 
speed  sensor,  water  depth  sensor,  and  a  data  processing  computer.  The  software  is  based 
on  a  twelve-state  complementary  filter  that  combines  measurement  data  from  all  sensors 
to  derive  a  vehicle  position/orientation  estimate.  This  paper  describes  hardware  and 
software  design,  and  testing  results  of  the  SANS.  It  is  shown  that  results  from  tilt  table 
testing  and  bench  testing  provide  an  effective  means  for  tuning  filter  gains.  Ground  vehicle 
testing  verifies  the  overall  functioning  of  the  SANS,  and  exhibits  an  encouraging  degree  of 
accuracy. 
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1  Introduction 

Autonomous  Underwater  Vehicles  (AUVs)  are  capable  of  a  variety  of  overt  and  clandestine 
missions.  Such  vehicles  have  been  used  for  inspection,  mine  counter  measures,  survey  and 
observation  [1],  Accurate  navigation  is  a  crucial  aspect  of  each  of  these  missions.  The 
Global  Positioning  System  (GPS)  is  capable  of  providing  this  accuracy  if  integrated  with 
an  Inertial  Navigation  System  (INS)  to  compensate  for  intermittent  reception  caused  by 
either  wave  action  or  deliberate  submergence.  Integrated  GPS/INS  systems  have  been 
applied  to  aircraft  and  space  shuttle  guidance  and  navigation  [2,  3,  4],  balloon  navigation 
[5],  missile  systems  [6,  7],  land  vehicles  [8],  and  mobile  robots  [9,  10].  In  these  applications, 
GPS  data  are  continuously  available  in  the  short  intervals  and  INS  data  are  used  to 
navigate  between  GPS  fixes.  The  SANS  is  designed  to  demonstrate  the  feasibility  of  using 
a  low-cost  strap-down  Inertial  Measurement  Unit  (IMU)  for  AUV  navigation  where  GPS 
data  may  not  be  available  for  an  extended  period  of  time  when  an  AUV  is  submerged. 
The  goal  of  the  SANS  is  a  self-contained,  internally  or  externally  mountable  package  which 
can  be  easily  carried  by  a  small  AUV.  The  initial  installation  target  for  the  SANS  is  the 
Naval  Postgraduate  School  “Phoenix”  AUV  [11,  12]. 

The  development  of  a  prototype  or  “proof  of  concept”  SANS  was  described  in  [13,  14]. 
Experiments  with  the  SANS  and  a  similar  system  [15]  support  the  belief  that  it  is  possible 
to  navigate  with  10  meter  rms  (root  mean  square)  accuracy  for  periods  of  up  to  several 
minutes  between  DGPS  position  fixes  using  a  low  cost  IMU.  The  system  reported  in  [13] 
was  separated  into  two  subsystems  to  enable  experiments  using  a  towfish  (small  tow  body), 
and  was  larger  in  size  than  that  given  as  a  SANS  goal  in  [16].  The  low  data  rate  of  this 
system  appeared  to  be  its  major  limitation.  Replacement  of  the  majority  of  the  hardware 
components  used  in  that  prototype  resulted  in  a  compact  single  unit  system  with  a  data 
rate  ten  times  higher  than  that  of  the  prototype  [17]. 

Throughout  the  development  of  the  SANS  system,  incremental  improvements  have 
been  made  to  the  twelve-state  constant  gain  complementary  filter  on  which  the  software  is 
based.  The  purpose  of  the  filter  is  to  utilize  IMU,  heading,  and  water-speed  information 
to  implement  an  INS  and  then  integrate  this  with  GPS  information  into  a  single  system 
which  produces  continuously  accurate  navigation  information  in  real  time.  Accelerometer 
data  is  used  as  a  low-frequency  data  complement  to  high  frequency  angular  rate  sensor 
data  for  orientation  estimation  and  as  a  high  frequency  linear  acceleration  data.  Proper 
tuning  of  the  filter  gains  has  proved  a  key  element  in  system  accuracy.  An  improved 
understanding  of  angular  rate  sensor  bias  estimation  has  lead  to  the  development  of  an 
effective  calibration  procedure  for  the  filter  [18]. 

Extensive  tilt  table  and  bench  testing  was  conducted  to  properly  tune  the  filter  gains. 
Bench  testing  results  with  different  gain  values  are  presented  to  show  the  effect  of  the 
filter  gains  on  the  estimation  accuracy.  Ground  vehicle  testing  was  also  conducted,  where 
the  SANS  system  was  mounted  on  a  moving  golf  cart.  Data  were  collected  while  the  cart 
was  driven  over  a  surveyed  course.  Results  from  ground  vehicle  testing  demonstrate  the 
feasibility  of  the  current  SANS  system.  Future  work  will  involve  at-sea  testing  using  a 
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small  remotely  operated  submersible  vehicle  (ROY). 


2  System  Description 

2.1  Hardware 

The  hardware  configuration  of  the  SANS  has  changed  and  improved  considerably  over 
the  course  of  development.  An  earlier  version  of  the  SANS  system  reported  in  [13]  was 
separated  into  two  subsystems.  The  IMU,  water  speed  sensor,  compass,  GPS  antenna,  and 
data  logging  computer  were  configured  in  one  package  and  placed  in  a  towfish.  The  GPS 
receiver,  DGPS  antenna,  and  data  processing  computer  were  placed  in  the  towing  vessel. 
The  data  collected  by  the  towfish  subsystem  were  transmitted  to  the  data  processing 
computer  through  a  modem  connection.  It  was  found  in  these  experiments  that  wave 
splash  on  the  GPS  antenna  had  no  serious  effect  on  GPS  signal  reception  during  time 
periods  when  the  towfish  was  surfaced  [13]. 

The  current  hardware  configuration  of  the  SANS  system  is  shown  in  Figure  1.  All  the 
components  in  this  configuration  are  physically  contained  in  a  single  self-contained  box 
with  dimensions  6  x  17  x  3  inches  [17].  Supplying  it  with  a  12  VDC  power  source  (e.g., 
a  12  VDC  battery)  is  all  that  is  needed  to  make  the  system  operational.  The  on-board 
processor  is  an  Extremely  Small  Package  (ESP)  Cyrix  486SLC  DX2  50  MHz  computer 
running  the  DOS  operating  system.  With  this  processor  alone,  a  sampling  rate  of  about  4 
Hz  was  achieved  [17].  In  the  current  configuration,  a  floating  point  math  coprocessor  was 
integrated,  resulting  in  a  ten  fold  increase  in  sampling  rate  from  4  Hz  to  40  Hz  [18].  The 
current  SANS  system  is  also  equipped  with  an  Ethernet  card  that  allows  it  to  be  connected 
to  another  computer(s)  via  a  TCP/IP  network  during  development  phase.  This  Ethernet 
interface  has  proved  to  be  an  extremely  useful  tool  for  transferring  programs,  logging  data, 
monitoring  the  system  status,  etc. 

To  improve  the  performance  and  reliability  of  the  SANS  system,  the  ESP  on-board 
processor  is  soon  to  be  replaced  by  an  AMD  586DX133  based  PC/104  module  computer. 

2.2  Software 

The  current  SANS  navigation  software  is  based  on  a  twelve-state  complementary  filter 
shown  in  Figure  2.  The  twelve  state  variables  are  the  outputs  of  each  of  the  three  integrator 
blocks,  estimated  current  in  north  and  east  directions,  and  the  bias  estimates  for  the 
angular  rate  readings.  The  state  variables  are  shown  in  Table  1.  In  Figure  2,  R((f>,6,ip) 
is  a  rotation  matrix  [19]  and  T(<p,  6,  'ip)  is  a  body  rate  to  Euler  rate  transformation  matrix 
[20]- 

In  the  filter  depicted  in  Figure  2,  all  gains  are  constant  and  are  initially  determined 
by  bandwidth  considerations,  followed  by  experimental  tuning.  Since  all  gain  matrices 
have  thus  far  been  constrained  to  be  diagonal,  the  approach  taken  to  date  is  based  on 
the  concept  of  “complementary  filtering”  [21,  13,  14],  The  results  presented  in  this  paper 
indicate  that  this  approach  works  well. 
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Euler  Angles 

<£,  ^  '0 

North  &;  East  Velocity 

2/e 

North  &  East  Position 

j  2/e 

Apparent  Current 

Xc,  Vc 

Angular  Rate  Bias  Estimates 

Pb,  Qbi  n 

Table  1:  State  variables  of  the  complementary  filter. 

3  System  Components  Testing 

Filter  gains  K\ .  iF2 ,  K 3,  and  K4  are  initially  assigned  based  on  bandwidth  considerations, 
and  subsequently  tuned  based  on  component  experimental  testing.  Tilt  table  testing  was 
conducted  to  tune  K\.  Bench  testing  was  carried  out  to  adjust  K%  and  K, 4.  A  calibration 
of  the  magnetic  compass  resulted  in  better  tuning  of  K 2.  Each  of  these  experiments  is 
described  below  in  more  detail. 

3.1  Tilt  Table  Testing  Results 

Due  to  the  aperiodic  nature  of  the  SANS  filter  and  a  lack  of  statistical  data  on  errors  in 
the  data  sensed  by  the  towfish,  analytic  determination  of  satisfactory  values  for  the  gain 
matrices  and  proper  scale  factors  for  the  input  data  has  proved  difficult  [22],  Consequently, 
in  order  to  be  able  to  precisely  control  input  to  the  filter,  the  SANS  unit  was  placed  on 
a  Haas  rotary  tilt  table,  Model  TRT-7  [23].  The  table  has  two  degrees  of  freedom  (DOF) 
and  is  capable  of  positioning  to  an  accuracy  of  0.001  degrees  at  rates  ranging  from  0.001 
to  80  degrees/second. 

Tuning  data  for  the  SANS  was  obtained  by  moving  the  SANS  unit  through  each  DOF 
at  varying  rates  within  a  45  degree  range.  The  attitude  as  determined  by  the  SANS  was 
then  plotted  and  compared  with  the  actual  motion  of  the  unit.  Through  this  comparison,  it 
was  possible  to  determine  initial  gain  values  and  scale  factors.  The  tilt  table  data  was  then 
post-processed  using  these  initial  values  and  once  again  compared  to  the  actual  motion  of 
the  SANS  unit.  This  process  was  repeated  several  times  until  the  attitude  determined  by 
the  filter  “matched”  the  true  motion  of  the  unit.  Angular  rate  biases  are  estimated  by  a 
low-pass  filter  with  a  time  constant  of  1000  seconds. 

Figure  3  is  an  example  of  the  results  obtained  during  the  tuning  process.  The  slight 
overshoots  following  each  motion  may  indicate  the  scale  factor  for  the  y  axis  angular  rate 
sensor  is  slightly  high.  However,  this  effect  may  also  be  due  to  undersampling  problems. 
The  flatness  of  the  curve  following  stabilization  after  each  motion  indicates  that  a  rea¬ 
sonable  gain  value  has  been  determined  as  does  the  distance  between  the  tails  of  each 
step. 

As  exemplified  by  Figure  3,  Tilt  table  tests  of  the  SANS  system  show  that  attitude 
sensing  is  achieved  to  an  accuracy  of  one  degree  or  better  under  the  most  demanding  of 
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circumstances  [18].  This  is  in  agreement  with  the  findings  of  other  investigations  [24]. 


3.2  Bench  Testing  Results 

To  tune  filter  gains  A3  and  KA,  a  series  of  bench  tests  were  conducted.  The  SANS  system 
was  mounted  on  a  golf  cart1.  The  cart  was  parked  throughout  bench  testing.  The  DGPS 
receiver  was  programmed  to  provide  a  GPS  fix  every  two  seconds.  Since  water  speed  is 
obviously  unavailable  in  bench  testing,  an  artificial  constant  water  speed  was  entered  in 
the  filter  program  in  place  of  water  speed  data.  In  what  follows,  results  for  constant  speed 
inputs  of  0.0  and  10.0  feet/second  will  be  presented. 

Figures  4  and  5  depict  the  testing  results  with  water  speed  being  set  to  zero.  In  this 
test,  the  filter  gains  were  chosen  to  be:  K\  =  0.1,  A2  =  0.5,  A3  =  2.0,  and  KA  =  0.01. 
Figure  4  shows  the  estimated  position  in  the  north-east  coordinates.  Since  the  test  is 
conducted  on  a  stationary  bench,  the  position  trajectories  should  stay  at  the  origin  in  an 
ideal  case.  The  SANS  estimate  of  position  is  within  an  area  of  10  x  10  square  feet.  The 
drift  in  the  position  estimate  is  due  mainly  to  GPS  errors.  The  estimated  currents  in 
north  and  east  directions  are  shown  in  Figure  5.  Ideally  they  should  be  zero.  The  small 
amount  of  the  estimated  currents  is  due  to  the  drift  in  the  position  estimate  caused  by 
GPS  errors. 

In  the  next  series  of  tests,  water  speed  is  set  to  10.0  feet/second  in  the  filter  program. 
A4  is  varied  from  0.01  to  1.0  while  keeping  all  other  gain  values  constant.  Since  the 
SANS  system  remains  stationary  on  a  heading  of  true  north,  a  current  estimate  of  -10.0 
feet/second  is  expected  if  the  SANS  filter  works  correctly.  Figure  6  shows  the  current 
estimate  for  KA  =  0.1.  Just  as  expected,  the  estimated  current  in  the  north  direction 
converges  to  -10.0  and  that  in  the  east  direction  is  about  zero.  A  smaller  KA  makes 
the  filter  slower  and  less  responsive  for  the  estimation  of  the  current.  For  example,  for 
A4  =  0.01  the  filter  takes  about  400  seconds  to  reach  the  steady-state  estimated  value.  A 
larger  KA  makes  the  filter  more  responsive,  but  results  in  a  noisier  estimate. 

Similar  testing  was  conducted  for  tuning  A3.  The  estimated  current  of  one  typical 
experiment  is  presented  in  Figure  7.  In  this  particular  case,  A3  is  reduced  from  2.0,  that 
was  used  in  all  the  previous  tests,  to  0.5.  KA  is  set  to  0.5  as  well.  Comparing  Figure  7 
with  Figure  6,  it  is  evident  that  larger  A3  values  produce  better  performance.  This  is  not 
surprising  since  a  larger  A3  places  more  confidence  on  water  speed  that  is  constant  and 
free  of  noise  during  bench  testing.  The  proper  value  for  A3  must  be  determined  again 
with  real  water  speed  data  when  at-sea  testing  is  performed. 

3.3  Compass  calibration  Results 

To  obtain  the  heading  information  in  the  SANS,  the  angular  rate  sensor  is  used  as  a  high 
frequency  input  source  and  the  digital  compass  (Precision  Navigation  Electronic  Compass, 
Model  TCM2)  is  used  as  low  frequency  data  source.  In  a  series  of  ground  vehicle  tests 

1See  Section  4  on  ground  vehicle  testing  for  the  purpose  of  using  a  golf  cart. 
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(see  Section  4  for  more  details),  it  was  noted  that  the  SANS  heading  is  off  by  a  few 
degrees.  Figure  8  shows  a  typical  run  of  ground  vehicle  testing  with  a  GPS  update  every 
10  seconds.  The  solid  line  is  the  filtered  vehicle  track  with  continuous  GPS  data,  and  is 
taken  as  a  reference.  The  dotted  line  is  the  filtered  vehicle  track  when  GPS  information 
is  provided  to  the  filter  every  10  seconds.  The  vehicle  starts  from  (0,  0)  coordinate,  moves 
westward,  continues  northward  after  a  right  turn,  and  returns  to  the  starting  location 
after  making  a  U-turn.  It  is  evident,  particularly  from  the  northerly  run,  that  the  filter 
is  not  receiving  accurate  directional  information.  A  comparison  of  raw  compass  data  and 
the  filtered  heading  points  to  the  compass  as  the  source  of  heading  error. 

The  investigation  of  compass  deviation  was  focused  on  three  areas:  possible  interference 
produced  by  the  golf  cart  electric  motor,  vibration,  and  the  deviation  of  the  compass  itself. 
The  TCM-2  compass  has  a  self  calibration  routine  which  is  supposed  to  remove  the  effects 
of  static  magnetic  fields  caused  by  ferrous  materials  in  the  vicinity  of  the  compass.  The 
calibration  routine  is  not  capable  of  compensating  for  dynamic  magnetic  field  distortions 
like  those  caused  by  an  electric  motor.  To  find  the  qualitative  effect  of  the  electric  motor 
on  the  compass,  a  series  of  tests  were  performed. 

The  tests  were  performed  by  jacking  up  the  rear  wheels  of  the  golf  cart  so  that  they 
could  spin  freely  while  the  motor  was  on.  The  motors  were  turned  on  for  30  second 
intervals  followed  by  a  30  seconds  off  time.  During  the  off  time,  the  wheels  continued 
to  rotate  for  approximately  10-15  seconds  until  they  came  to  a  stop.  This  test  allowed 
changes  in  heading  due  to  motor  engagement  to  be  observed.  The  same  test  was  performed 
four  times  rotating  the  cart  through  the  cardinal  points.  The  result  of  one  such  test  (with 
the  vehicle  facing  east)  is  depicted  in  Figure  9.  Testing  results  indicate  that  there  is 
interference,  but  its  magnitude  appears  to  be  limited  to  approximately  a  half  of  a  degree. 
The  figure  also  indicates  that  the  noise  is  at  a  relatively  high  frequency  which  can  be 
compensated  for  with  an  appropriate  value  for  K2.  Similar  results  were  obtained  with  a 
full  load  applied  to  the  motor. 

The  effect  of  vibration  was  tested  by  lightly  tapping  the  compass  board  with  a  screw¬ 
driver  and  a  finger.  Figure  10  shows  compass  reading  obtained  in  this  experiment.  It  is 
seen  that  vibration  clearly  plays  a  much  greater  role  in  compass  error  than  the  electric 
motor.  However,  these  deviations  are  mostly  in  a  high  frequency  range,  and  can  be  filtered 
out  with  an  appropriate  choice  of  K 2. 

In  ground  vehicle  testing,  it  was  noticed  that  heading  error  during  east-west  runs  was 
not  as  large  as  during  north-south  runs.  A  final  test  was  conducted  to  determine  if  compass 
deviations  that  are  heading  dependent  are  present.  The  test  was  performed  by  swinging 
the  compass  and  comparing  the  compass  reading  with  a  reference.  The  instrument  used 
as  the  reference  was  a  transit  manufactured  by  W.  and  L.E.  Gurley  with  a  accuracy  of 
0.5  degrees.  It  has  a  calibrated,  balanced  magnetic  compass  mounted  within  its  body.  By 
mounting  the  transit  in  line  with  the  TCM-2  compass,  a  comparison  is  made  between  the 
two  indicated  headings.  The  compass  was  swung  through  the  entire  360  degrees,  taking 
measurements  every  10  degrees.  Figure  11  shows  the  difference  between  measurements 
of  the  transit  and  those  of  the  TCM-2  compass.  Figure  11  is  qualitatively  in  agreement 
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with  the  observation  made  during  ground  vehicle  testing  where  north-south  runs  show 
greater  heading  errors  than  east-west  runs.  Using  this  data,  a  lookup  table  and  linear 
interpolating  function  was  added  to  the  SANS  filter  code  to  compensate  for  the  heading 
dependent  deviation.  It  is  noted  that  both  TCM-2  compass  and  transit  measure  magnetic 
heading,  whileas  DGPS  provides  the  geographic  North.  As  shown  in  Figure  2,  the  magnetic 
declination  of  15°  in  Monterey,  California  is  compensated  in  software. 

To  eliminate  high  frequency  effects  of  DC  motors  and  vibration,  the  value  of  K2  was 
decreased  from  previous  0.5  to  0.1.  This  corresponds  to  a  time  constant  of  10  seconds, 
which  makes  the  filter  less  responsive  to  high  frequency  transients  caused  by  DC  motors 
and  vibration. 

4  Ground  Vehicle  Testing 

In  addition  to  tilt  table  testing  and  bench  testing,  a  series  of  ground  vehicle  tests  were 
performed  in  preparation  for  at-sea  testing.  In  ground  vehicle  testing,  the  SANS  system 
was  installed  on  a  golf  cart  as  shown  in  Figure  12.  The  cart  was  driven  around  a  surveyed 
course  in  a  moderately  sloped  parking  lot.  Due  to  lack  of  speed  measurements  in  the 
initial  tests,  the  cart  was  driven  in  the  parking  lot  for  a  number  of  complete  turns  with 
constant  acceleration  foot  pedal  position,  and  the  total  traveling  time  was  measured.  An 
average  speed  was  calculated  based  on  the  observed  time  and  length  of  the  course,  and 
hand  coded  into  the  software. 

Results  from  one  representative  ground  vehicle  test  are  presented  in  Figures  13  through 
17.  During  this  test,  the  filter  gains  were  set  to:  K\  =  0.1,  K 2  =  0.5,  K%  =  2.0,  and 
K.i  =  0.01.  The  calculated  average  cart  speed  is  11.6  feet/second.  Continuous  DGPS  data 
was  available  throughout  this  test.  Figure  13  shows  the  estimated  position  trajectory  of 
the  cart.  The  cart  started  from  (0,0)  position,  and  traveled  westward  for  about  120  feet 
before  making  the  first  right  turn.  The  cart  then  traveled  northward  for  about  450  feet, 
made  a  U-turn,  and  returned  to  the  starting  point  along  the  other  leg  of  the  parking  lot 
driveway.  The  parking  lot  is  fiat  with  a  slight  downward  slope  toward  the  north  end.  All 
data  were  collected  at  one  second  intervals.  The  effect  of  this  slope  on  cart  speed  can  be 
observed  by  comparing  the  fix  spacing  on  the  north  and  south  bound  legs. 

Figure  14  shows  the  heading  from  raw  compass  data,  while  Figure  15  shows  the  heading 
produced  by  the  navigation  filter.  Similarity  is  clearly  observed  in  these  two  plots.  It  can 
be  seen  that,  as  expected,  the  filter  output  is  smoother  than  the  raw  compass  data.  The 
heading  is  in  agreement  with  the  position  plot. 

The  estimated  current  is  plotted  in  Figures  16  and  17.  As  mentioned  earlier,  the 
average  speed  of  the  cart  was  computed,  and  input  into  the  program  in  place  of  speed 
through  the  water.  If  the  cart  moves  faster  than  the  assumed  average  speed,  the  filter 
will  attribute  the  difference  to  current.  Since  the  parking  lot  has  a  downward  slope  from 
the  south  (starting)  end  to  the  north  end,  the  cart  moves  faster  northward  (out  bound 
leg),  and  slower  southward  (return  leg).  This  is  evident  from  denseness  of  dots  in  Figure 
13  since  data  were  collected  at  equal  time  intervals.  The  dots  along  the  left  leg  of  the 
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plot  are  visibly  sparser  than  those  along  the  right  leg.  From  the  heading  plots,  it  is  seen 
that  the  cart  started  making  the  U-turn  at  about  50  seconds.  Prior  to  the  U-turn,  the 
filter  estimated  a  positive  north  current  of  3.2  feet/second,  as  shown  in  Figure  17.  From 
the  first  right  turn  until  the  U-turn,  the  cart  traveled  some  450  feet  in  about  30  seconds 
(from  20  to  50  seconds  in  time).  The  actual  average  speed  along  this  segment  of  path  is 
thus  15.0  feet/second,  which  is  3.4  feet/second  faster  than  the  speed  (11.6  feet/second) 
programmed  into  the  filter.  Therefore,  the  filter  successfully  estimated  the  current.  After 
the  U-turn,  the  filter  qualitatively  predicted  the  slowdown  of  the  cart  speed,  but  was  not 
able  to  converge  prior  to  the  end  of  the  test.  This  is  because  K, t  was  set  to  0.01  in  this 
test.  The  corresponding  time  constant  is  100  seconds.  It  will  thus  take  about  400  seconds 
for  the  filter  to  converge.  That  is,  the  experiment  duration  was  too  short  for  the  filter 
to  converge.  More  ground  vehicle  testing  is  planned  with  larger  K 4  (thus  smaller  time 
constant)  and  longer  testing  duration. 

The  ground  vehicle  tests  described  above  were  conducted  with  continuous  DGPS  data. 
The  vehicle  speed  was  crudely  estimated  based  on  the  length  of  the  traveling  course  and 
traveling  time,  and  assumed  a  constant  value  throughout  testing.  To  better  estimate  the 
vehicle  speed,  a  bicycle  wheel  was  instrumented  and  trailed  behind  the  golf  cart.  The 
bicycle  wheel  was  provided  with  a  reed  switch  and  a  magnet  that  generates  a  pulse  upon 
every  revolution.  Counting  the  elapsed  time  between  two  pulses  provides  a  better  estimate 
of  the  average  speed  [25]. 

After  implementing  the  bicycle  wheel  speed  measurement  and  compensating  heading- 
dependent  compass  deviation  (based  on  Figure  11),  another  ground  vehicle  test  was  con¬ 
ducted  over  a  different  course.  The  result  of  this  test  is  depicted  in  Figure  18.  The  dotted 
line  represents  the  vehicle  trajectory  with  continuous  GPS  data.  The  solid  line  is  the  tra¬ 
jectory  of  the  vehicle  following  the  same  path  without  GPS  data  during  the  entire  run  of 
3.2  minutes.  Taking  the  dotted  line  as  the  reference,  it  is  seen  that  the  result  of  dead  reck¬ 
oning  navigation  without  GPS  is  accurate  to  within  10  meters  or  better  throughout  this 
period  of  operation.  It  is  encouragingly  hoped  that  this  accuracy  can  also  be  demonstrated 
in  submerged  navigation  during  at-sea  testing. 

5  Current  and  Future  Work 

This  paper  presents  the  current  status  of  the  continuing  SANS  research  and  development 
effort.  More  hardware/software  upgrades  and  experiments  are  in  progress.  In  particular, 
the  onboard  ESP  computer  is  being  replaced  by  an  industrial  standard  PC/104  computer. 
The  paddle-wheel  water  speed  sensor  used  in  earlier  experiment  [13]  will  be  replaced  by  a 
a  more  accurate  three-axis  ultrasonic  water  velocity  sensor.  An  eight  state  asynchronous 
Kalman  filter  is  being  implemented  for  position  and  current  estimation  to  replace  the 
ad  hoc  implementation  of  this  function  shown  in  Figure  2  [26].  At-sea  testing  will  be 
conducted  when  hardware  and  software  upgrades  are  completed. 
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6  Conclusions 


This  paper  reports  on  research  progress  in  the  development  of  the  SANS  system.  The  new 
hardware  configuration  of  the  system  allows  all  the  components  to  be  packaged  in  a  single 
self-contained  box.  The  sampling  rate  of  the  system  is  ten  times  faster  than  the  previous 
prototype.  Bench  testing  and  ground  vehicle  testing  on  a  golf  cart  were  conducted  to 
validate  proper  working  of  the  new  configuration,  to  tune  filter  gains,  and  confirm  the 
feasibility  of  the  SANS  concept.  Test  results  indicate  that  filter  gains,  for  the  most  part, 
can  be  tuned  relying  on  convenient  bench  testing  or  ground  vehicle  testing.  Evaluation  of 
GPS  multipath  effects  and  other  wave-induced  errors  awaits  future  at-sea  testing. 

7  Acknowledgments 

This  research  was  supported  in  part  by  National  Science  Foundation  under  grant  No. 
CDA-9729814,  by  Florida  Atlantic  University  under  Agreement  No.  NP787,  and  by  the 
Defense  Advanced  Research  Project  Agency  under  ARPA  Order  C309/06. 

References 

[1]  J.  Yuh.  Underwater  Robotic  Vehicles:  Design  and  Control.  TSI  Press,  1995. 

[2]  Robert  A.  Gray  and  Peter  S.  Maybeck.  An  integrated  GPS/INS/BARO  and  radar 
altimeter  system  for  aircraft  precision  approach  landings.  In  Proceedings  of  IEEE 
1995  National  Aerospace  and  Electronics  Conference ,  pages  161-168,  Dayton,  OH, 
May  1995. 

[3]  Kevin  Braden,  Clint  Browing,  Hendrik  Gelderloos,  and  Fred  Smith.  Integrated  inertial 
navigation  system/global  positioning  system  INS/GPS  for  manned  return  vehicle 
autoland  application.  In  Proceedings  of  IEEE  1990  Position  Location  and  Navigation 
Symposium,,  pages  74-82,  March  1990. 

[4]  Geoffrey  Barnes.  INS/GPS  space  application  for  all  flight  dynamics  —  boost  through 
landing.  In  Proceedings  of  IEEE  1996  Position  Location  and  Navigation  Symposium. 
pages  457-463,  April  1996. 

[5]  Christopher  Jekeli.  Balloon  gravimetry  using  GPS  and  INS.  IEEE  Aerospace  and 
Electronics  Systems  Magazine.  7(6) :9  15,  June  1992. 

[6]  Renato  S.  Ornedo  and  Kenneth  A.  Farnsworth.  GPS  and  radar  aided  inertial  nagi- 
vation  system  for  missile  system  applications.  In  Proceedings  of  IEEE  1998  Position 
Location  and  Navigation  Symposium,,  pages  614-621,  Palm  Springs,  CA,  April  1998. 

[7]  Michael  K.  Martin.  New  low  cost  avionics  with  INS/GPS  for  a  variety  of  vehicles. 
In  Proceedings  of  AIA A/IEEE  Digital  Avionics  Systems  Conference,  pages  8.3-1  to 
8.3-8,  October  1997. 


9 


[8]  Richard  Tranfield.  INS/GPS  navigation  systems  for  land  applications.  In  Proceedings 
of  IEEE  1996  Position  Location  and  Navigation  Symposium ,  pages  391-398,  April 
1996. 

[9]  Billur  Barshan  and  Hugh  F.  Durrant-Whyte.  Inertial  navigation  systems  for  mobile 
robots.  IEEE  Transactions  on  Robotics  and  Automation ,  11(3) :328  342,  June  1995. 

[10]  Salah  Sukkarieh,  Eduardo  M.  Nebot,  and  Hugh  F.  Durrant-Whyte.  Achieving  in¬ 
tegrity  in  an  INS/GPS  navigation  loop  for  autonomous  land  vehicle  applications.  In 
Proceedings  of  the  1998  IEEE  International  Conference  on  Robotics  and  Automation, 
pages  3437-3442,  Leuven,  Belgium,  May  1998. 

[11]  D.B.  Marco,  A.J.  Healey,  and  R.B.  McGhee.  Autonomous  underwater  vehicle:  Hybrid 
control  of  mission  and  motion.  Autonomous  Robots,  3(2/3) :169— 186,  June  1996. 

[12]  Don  Brutzman,  Tony  Healey,  Dave  Marco,  and  Bob  McGhee.  The  Phoenix  au¬ 
tonomous  underwater  vehicle.  In  D.  Kortenkamp,  R.P.  Bonasso,  and  R.  Murphy, 
editors,  Artificial  Intelligence  and  Mobile  Robots:  Case  studies  of  successful  robot 
systems,  chapter  13,  pages  323-360.  MIT  Press,  Cambridge,  MA,  March  1998. 

[13]  R.B.  McGhee  et  al.  An  experimental  study  of  an  integrated  GPS/INS  system  for 
shallow- water  AUV  navigation  (SANS).  In  Proceedings  of  9th  International  Sym¬ 
posium,  on  Unmanned  Untethered  Submersible  Technology  ( UUST '),  Durham,  NH, 
September  1995. 

[14]  E.R.  Bachmann,  et  al.  Evaluation  of  an  integrated  GPS/INS  system  for  shallow  water 
AUV  navigation.  In  1996  IEEE  Symposium  on  Autonomous  Underwater  Vehicle 
Technology,  pages  268-275,  Monterey,  CA,  June  1996. 

[15]  Richard  L.  Thorne.  Asynchronous  data  fusion  for  AUV  navigation  using  extended 
Kalman  filtering.  Master’s  thesis,  Naval  Postgraduate  School,  Monterey,  California, 
March  1997. 

[16]  S.H.  Kwak  et  al.  An  experimental  investigation  of  GPS /INS  integration  for  small  AUV 
navigation.  In  Proceedings  of  8th  International  Symposium  on  Unmanned  Untethered 
Submersible  Technology  (UUST),  Durham,  NH,  September  1993. 

[17]  Randy  G.  Walker.  Design  and  evaluation  of  an  integrated,  self-contained  GPS/INS 
shallow-water  AUV  navigation  system  (SANS).  Master’s  thesis,  Naval  Postgraduate 
School,  Monterey,  California,  June  1996. 

[18]  R.L.  Roberts.  Implementation  and  evaluation  of  an  integrated  self-contained 
GPS/INS  shallow-water  AUV  navigation  system  (SANS).  Master’s  thesis,  Naval 
Postgraduate  School,  Monterey,  California,  March  1997. 

[19]  John  J.  Craig.  Introduction  to  Robotics:  Mechanics  and  Control.  Addison  Wesley 
Publishing  Company,  2nd  edition,  1989. 


10 


[20]  R.B.  McGhee  and  A.  A.  Frank.  Some  considerations  relating  to  the  design  of  autopilots 
for  legged  vehicles.  Journal  of  Terramechanics ,  6(1),  1969. 

[21]  Robert  Grover  Brown  and  Patrick  Y.C.  Hwang.  Introduction  to  Random,  Signals  and 
Applied  Kalman  Filtering.  John  Wiley  &  Sons,  New  York,  NY,  third  edition,  1997. 

[22]  E.R.  Bachmann  and  D.L.  Gay.  Design  and  evaluation  of  an  integrated  GPS/INS  sys¬ 
tem  for  shallow-water  AUV  navigation.  Master’s  thesis,  Naval  Postgraduate  School, 
Monterey,  California,  September  1995. 

[23]  Anon.  Model  TRT-7  Tilting  Rotary  Table.  Hass  Automation,  Inc.,  Chatsworth,  CA, 
July  1992. 

[24]  R.  Wolf,  G.W.  Hein,  B.  Eissfeller,  and  E.  Loehnert.  An  integrated  low  cost  GPS/INS 
attitude  determination  and  position  location  system.  In  Proceedings  of  ION  GPS-96 
Meeting,  pages  975-981,  Kansas  City,  MO,  September  1996. 

[25]  Randall  Knapp.  Calibration  and  evaluation  of  a  water  speed  indicator  and  compass 
for  the  small  autonomous  underwater  vehicle  navigation  filter.  Master’s  thesis,  Naval 
Postgraduate  School,  Monterey,  California,  December  1997. 

[26]  X.  Yun,  G.C.  Hernandez,  E.R. Bachmann,  R.B. McGhee,  and  A.J.  Healey.  An  inte¬ 
grated  GPS/INS  navigation  system  for  small  AUVs  using  an  asynchronous  kalman 
filter.  In  Proceedings  of  IEEE  Conference  on  Autonomous  Underwater  Vehicle 
(AUV’98),  Cambridge,  MA,  August  1998. 


11 


UnrijnjJalrcl  12  VDC 


Figure  1:  Block  diagram  of  the  new  SANS  hardware  configuration. 
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Figure  2:  Diagram  of  the  SANS  navigation  filter. 


Figure  3:  Forty-five  degree  pitch  excursions  at  five  degrees  per  second. 
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Figure  4:  Position  plot  of  bench  testing  with  water  speed  being  set  to  zero,  K\  =  0.1 
K2  =  0.5,  K3  =  2.0  and  K4  =  0.01  for  a  duration  of  160  seconds. 


Figure  5:  Estimated  current  for  bench  testing  with  water  speed  being  set  to  zero,  K\  =  0.1 
K-2  =  0.5,  K3  =  2.0  and  K4  =  0.01. 


14 


Time  (seconds) 

Figure  6:  Estimated  current  for  bench  testing  with  water  speed  being  set  to  10.0 
feet/second,  K\  =  0.1,  K2  =  0.5,  K3  =  2.0  and  K,±  =  0.1. 
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Figure  7:  Estimated  current  for  bench  testing  with  water  speed  being  set  to  10.0 
feet/second,  K\  =  0.1,  K2  =  0.5,  =  0.5  and  K 4  =  0.5. 
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Figure  8:  Position  plot  prior  to  compass  calibration  from  ground  vehicle  testing  with  GPS 
update  every  10  seconds. 


Figure  9:  Effect  of  the  golf  cart  motor  on  compass  measurements. 


